WO 2005087452 A1 
2005JP2005004838 2005/ 3/17 
JP 2004 2004077214 A (2004/ 3/17) 
2005/ 9/22 



[ENG] ROBOT DEVICE, BEHAVIOR CONTROL METHOD FOR THE ROBOT DEVICE, 
AND MOVING DEVICE 

[FRE] DISPOSITIF ROBOT, PROCEDE DE COMMANDE DE COMPORTEMENT 
POUR CE DISPOSITIF ROBOT ET DISPOSITIF MOBILE 

SONY CORP (JP); GUTMANN STEFFEN (JP); FUKUCHI MASAKI (JP) 

GUTMANN STEFFEN (JP); FUKUCHI MASAKI (JP) 

B 25 J 1 3/00 A; B 25 J 5/00 B 



[ECLA] B62D57/032 



AE 


AG 


AL 


AM AT AU AZ BA 


BB 


BG 


BR 


BW 


BY 


BZ 


CA 


CH 


CN 


CO 


CR 


CU CZ DE DK DM DZ EC 


EE 


EG 


ES 


FI 


GB 


GD 


GE 


GH 


GM 


HR HU ID IL IN 


IS 


JP 


KE 


KG 


KP 


KR 


KZ 


LC 


LK 


LR 


LS 


LT LU LV MA MD 


MG 


MK 


MN 


MW 


MX 


MZ 


NA 


NI 


NO 


NZ 


OM 


PG PH PL PT RO 


RU 


SC 


SD 


SE 


SG 


SK 


SL 


SM 


SY 


TJ 


TM 


TN TR TT TZ UA 


UG 


US 


UZ 


VC 


VN 


YU 


ZA 


ZM 


ZW 


[BW 


GH GM KE LS MW 


MZ 


NA 


SD 


SL 


SZ 


TZ 


UG 


ZM 


ZW 


AM 


AZ 


BY KG KZ MD RU 


TJ 


TM 


AT 


BE 


BG 


CH 


CY 


CZ 


DE 


DK 


EE 


ES FI FR GB GR 


HU 


IE IS 


; IT 


LT 


LU 


MC 


NL 


PL 


PT 


RO 


SE 


SI SK TR BF BJ 


CF 


CG 


CI 


CM 


GA 


GN 


GQ 


GW 



ML MR NE SN TD TG] 



abstract A robot device observes the external world by a stereo vision system (1) 
and outputs stereo data (D1) as a distance image, the stereo data (D1) being 
three-dimensional distance information calculated by a parallax of both eyes. A plane 
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detector (2) detects planes from the distance image to recognize the planes present 
in the environment. From plane data (D2), a stair recognizer (3) extracts a plane which 
the robot can climb up and down, recognizes a stair from that plane, and outputs stair 
data (D4). A stair climb-up/-down controller (4) outputs a behavior control command 
(D5) for realizing the movement for climbing up and down the stair by using the stair 
data (D4). This enables a mobile body itself to obtain information on a stair to 
autonomously perform the movement of stair climb up and down. 

Dispositif robot qui observe le monde exterieur a I'aide d'un systeme de vision stereo 
(1) et produit des donnees stereo (D1) en tant qu'image de distance, lesdites donnees 
stereo (D1) etant des informations de distance en trois dimensions calculees par une 
parallaxe des deux yeux. Un detecteur (2) de plans detecte des plans a partir de 
I'image de distance pour reconnattre les plans presents dans I'environnement. A partir 
des donnees de plans (D2), un reconnaisseur (3) d'escalier extrait un plan que le robot 
peut monter et descendre, reconnaTt un escalier dans ce plan et produit des donnees 
d'escalier (D4). Un dispositif de commande de montee / descente (4) des marches 
produit une instruction de commande de comportement (D5) permettant au robot 
d'effectuer le mouvement de montee et de descente des marches a I'aide des 
donnees d'escalier (D4). Cela permet a un corps mobile d'obtenir des informations sur 
un escalier pour effectuer de maniere autonome le mouvement de montee et de 
descente dudit escalier. 
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(57) Abstract: A robot device observes the external world by a stereo vision system (1) and outputs stereo data (Dl) as a distance 
image, the stereo data (Dl) being three-dimensional distance information calculated by a parallax of both eyes. A plane detector (2) 
^| detects planes from the distance image to recognize the planes present in the environmenL From plane data (D2), a stair recognizer 
(3) extracts a plane which the robot can climb up and down, recognizes a stair from that plane, and outputs stair data (D4). A stair 
climb-up/-down controller (4) outputs a behavior control command (D5) for realizing the movement for climbing up and down the 
stair by using the stair data (D4). This enables a mobile body itself to obtain information on a stair to autonomously perform the 



movement of stair climb up and down. 
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1-4 : ¥-m*Mrftfz>&-& ^<omM 

©^®©t^ (i) ^tt©t*fco-c, n^yymn^M^tim^. 

mxn%:1M<DM$?-tirZ>Z.bffX%Z> 0 7v>b^i?FERXf/^y?^yi/BE<Dmn 
tVXte, ^tLb<Dffi&<DmW£t*birZ>zbtfX%Z> 0 *7c, ±M&ftl&frbV&tk<D 

ifgW (width), PgJ£cDft£ (length) t£b*<Dmn&'&Z)Z.ktfXZZ> 0 P£l£tf>i«£( 
^0±lf){t, ^^^tvfc¥®X-^D2<D5{Z®<D^;il^^|jj=gbT, 2?>sp®CD<£ 



* 



• 

PCT/JP2005/004838 



WO 2005/087452 20 



w m mwt,'*?*—?) (D^yy*mwt"f--? i Dzk~rz>z-ki£x-%z> a 

3-2 : &3t<Dl6£ (height) ^SfJfeOBWtWT 
3-3 : P£&t<Dmw (width) &ffife<D W^gA-h 

■ 

3-4 : Pg|S:<Dft£L (length) s6S9f3g<D|H«£il± 
BI15W:, Pt^m^5<DPt^(±S^SC0#)li^i-^n-^-Y— bX&Z> 0 HI 15 

(DSFffi^M^mki , n , n)£Lfc#£\ | sin n | >min -efc*l,fijWT?&5 

x y z -1 z th 

kmWr1rZ>Z.kftX%Zo ww-e, min tt, Tk^Pffi^JWrf *^fe«>BB<e-e*>t). 

th 

tf, ^/Bi-ssatt^-^ ^m&mtekmm&^iM.LrXnim =so° *^u-c.tk 

th 

#«. mwr, ±30° Mm<7>Mz&&<>xhmntitii*.®m}^mx&iv&. 

Ztitb<Dft&&m<D¥&&&tH1r%£5\z1rtb]-££\<\ ^y^Sl\zx^X^^ 

kmm^m^i^Ty^siM^mK^vt^k^m^x^m^mru 
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fcfeO^a^T^o ££"CBU ^!lx.^SklanskyOT/V=fyXA(J. Sklansky, "Measuring 
concavity on a rectangular mosaic", IEEE Trans Comput.21,1974,pp.l355-1364) ^ 
MelkmanOT/^ yXA (Melkman A., "On-line Construction of the Convex Hull of 
a Simple Polygon" Information Processing Letters 25,1987,p.ll)ft<^<D[fV&-^\ M 

ISb6»fe, ^S&<D^18lc*5VvrHu HtaftB!Sr*i-3piB l£:}3tt5*iW (width) 

(length) z.titb<Dmt>mfe<7>mw.£<9±^ ^zofrmwrtz Wrv 

¥ffi<B*&fttfS£ &ffiM<D fflmU-tX&ZWrS- (^T-yZfS4 : No) . 8Hb"5TtB* 
l@®^&£t¥U$rU£;&<£>-^-: (Left Margin, Right Margin) ^rff^b(^^7°S 

& (convex hun)tt\mU£&<DktZ>Z.b&X%Z> 0 **5. G^-T^te, ^i"^ 

Z<D£5te&&mmVX&&mZZ&fr5T;^VXJ*<DMklsX, ±&Vfc£5\z. 

, Melkman<DT/V=?yXA, SklanskyOT/l^yXA&^fcSo ®17{*. MelkmanO 
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$&tiZ>&&3MJ>l, P2, P3&ttiU ,&P1, P2Srfe^ilft^«r§l#, ^Pl. P3^ , P 

2, P3£iS£iiGtfcS:3l<o -tLlCi^, 3,&P1, P2, P3a>£>fc5H£j#AR4$r&i?5 

nsd^JpJWf u-c#^ j^^mJ^rh\ ^ tm&mo m,x a jg«r»ri/c 

V>< 0 0d^.tfP4*S, ^#6AR1K:#&**-5*S\ PI, P2, P4, P3©>gj£-e&A/fc:*& 

^Ei"5«^{j:W:> ^nWl, P2, P3, P40MSrts-eilS^«j|ft^R:ffl*h/fcfiH«, 
PI, P4, P2, P3(D)iR^^fcll^l-H*tvfc^^U-C(£lj#^^Sr3efri-So 
«AR4, i-J&fc-bfi^^rtSlJ^j^P^^h^^H:, £b#^ff^{*S 
f*f, ^^AR2^P4^feS^f*. j£P3F±6fc#Pl, P2, P3©JW*-C*£ 

Sklansky(DTyV^!;XAt3j;?)|*t±i$iX ; S#^?^{i> Weakly Externally 
Visible Polygon Wtf;ix<5t>tf>"Cfc ; 5a^ J^OSldanskycDT/l^itLTfr^ft/^ft 

fc Hl^ 1 3 1 co^# _b«>ffi§:tf>j£xfl >P> 07^ 1 3 1 £r£tr R 1 3 2 ^UT^tt^ 5 1 < 
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§ 0 drr\ &mM<D]&Mlzm^x^ ^ru-*\f*j-3^*/*TJ*i<Dffi%t, mWzE 

-rm^mxhox, mi9A«, A^fh^mxmstepoi-t^&^BB^:^ 

M*V\,^&k^temM&±'£X\^ 0 Z<D£5te#&2>-%B*MttfebLX, 

^yzfm^ty4^^h\zx^mit^<>xA^m^^^^M^ 

&B (input polygon) £r^U !2l20Bte, A^J¥ m&^l-^fi&frb^&W^^y 

(close gaps) ^P^bbfc^-^^(^-V5/^*#-^^: gaps closed 

polygon) £r^U Hl20Cte, IS20B-e#e>^fc#^^^>^UT9-r>'^^-f^^ 
£9 (fit line segments) M(£WiteLfc#:ft^(¥^fc#:^: smoothed polygon) t? 

m21te. ^yy J '^^by^y^yHz.X.^mt\z.X^XXt}^^: 

^•V^^^rl^^-rSClose gapsMS, Rm§bfttc£j%mzftVX ; 7^7^yy L ^ 
?te£.V^iz¥-m4k1rZ)Fit line segments^S^LTV ^ c 



« 
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FE 

BE 

^x\ &m&Gtt. mffibf£Z¥-m<Dm*fcx$>tb\t£<, mz-tz. ^^—^ 

lsytf^h<Dtp'bM.bVtc.y, &ftJ&l40<Dm<L-bV,tdO, yv^h^yi?FERXfis*y 

y^yi^BE(D^A^m^tcm22B\Z^^±mi^l52<Dm'^bVtz'0ir^t^X 
flBm&VvtWu IH22B, 023lC^i-J;5^xS^a«6l52©^Jg|FBt^— >VM 

12 12 

KWH'SfcOfcl-So ;fc&<£>-^— i-^M , M tt, -yn>-h^yi/FERXf^yy=c-yi/ 

1 2 
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2 

, ,&142, 143, 146-Cfc5 0 ^±n^l52<D^M^m^t'^—^>M 

2 

^yv^FE, /^^^^v^BE^ffl^S^^lSl^SiU-CMf^i-^COi-r^o * 
^X\ @22B^^i-J;5^x ^nVh^i^FEtlRl— WMiZ-$$ttZ>i£-^— i?lsM 

1 

<Dft££rlmf£U ^y^y^BEtlflJ— iH^lC*3{t5&-v— vVM^^^lbrnt 

2 

&mx&Z>o m24Atz.7jk1r<D\^ HHO^bfcJ:5^M^*^"^o?F^^ 

Pgl£-e£>3^ |g!24Bii, MUfi! (spiral) y&pgmX&Zo Z.<Dm24B(D£? tMtfiPg 
jfctf), ^a^h^^FE^L^^^^/^BE^^feSCt^J;^, £©J:5&ttUi£raS! 
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*-f , ^topg^y 2 — ^(New Stairs) t-SrVNBST*—^ (Old Stairs) ££A;^U* 
T^x/Sll) , gfbV^RIS^— ^S.tJ'*V>ie©7 f — ^©^TS:lo©^(ujnion) b 

«(^^si2) 0 r^^^ixfc^^-^m-^^^v^-c, ^Wift^- ^ 

— ^s^L-CV^ftfgkT*— ^SrtftSRL (^5^^313) . ^^LTV ^5ja#*> 

5^^tt(^^^S14:Yes) , *ixfeO»a!Srtt^Ur^«P»»9*— ^A^^S 

— *ST11, ST12^-To SMWlCtf-— ?y-7L,X\^frl£0fr<D¥\mx\tt, W 

11 12 

1 3 

PgJ£x-*ST13£i-5 0 

j&frg-fcBSLTra, pgU:^— ^STll, ST12^ir^#(D^i&£r*7^7 B S 
T13fcU ^tff^^T 2 — *STli;Rtf|&S9*— *ST12tf>;fc^0>^— 

1 2 

X— ^STll^^nVh3i^FEt|^^X^^ST12<D7n^^^v?FE£D^^cD^ 
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4-1 : ^ (Search) WiYf 
4-2 : (Align) Sbf£ 

>-b^^FEOtp>i>^36^E^i~S*"fRlf-^f^SE8tad (align.distance) $ttlfc g tfj 
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tfSgfr %<K Pifimax.d^ JbBitV-CV ^WBtRXJ^y n^hzt^FE t^EfTl"*^ fR] t n 

BWi:-fST9^HStflll72^1b«rHI*&U £^©*M*&iftfcUfcfc#* 

ftftsas^Tbfc^JHfr^Sfc^-rSo -^fe^Biffi^U'C^, #Ix.fc£max_d=3(cm) 
, max_a=2° ^S^S^Sc 
4-3 : T^xi— f- (Approach) t&f^ 

Mgn_distancefcft8tnfc @ 6<J^g-e3!>5T7^>'&gl72^#SjbTT^>'tl)f^ 

FE 

approach_x) @ (^T, T^n— ^{&g£V ) ^ftt^o 

4-4 : f^J* (Climb) tftf^ 

4-5 : =y v-^ (Finish) ti)-f^ 

MftMl&ZtlZb. ^(Search) • T^fV (Align) 'TTV— ^ (Approach) tljffrc 

» PgStfUgfcB ^ia<5<T^cz-^tbf^^ ; ffi-S(^5/7 0 S2l) o :©f-f-77 
^.T^°ci-^»)^^bfc^(^X^S22:Yes) , ^Jfii-S^Tfe^rp»S 
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7>7°S22:No) , ^bfcnir^tii^L-CM^T-r^o i<D^li, t>5— , * 
7 l S'7 p S210«!.a*^lft«95S-t-*^i-5o 

H=ffi-5(^^^S32) 0 -9— ^»fls(l)-m, ^-SrtRU-CtS^JtJSv ^<6ffl©«« 

fij^step min z<n <stepjnax^S^Rfci-*&fc N #P£ RftB-efcSWJ 

Z 2 

»Tf 5 0 #P^RT^^^feofc#'a-(^v 1 5/^S32:Yes), WS^<T?»«bfc 
*5i~fcfe fc, »a»!:*fL.Tft«) feh/fcffi* (align_distance) 3rC#»i-5T9-'fVSj 

fls&sfefrL (^7^^333) ^ #l^bJ;5£bTV^I«£^fS!&-r ; 5 (^y^S34) 

0 ^<©^^s34coib^ s i^— ^Kif£(2)-efc3o 
■eb-c, #i^pT^^-r-fe^^^ss^Bb(^^s35). ■y—^-mm 

brv^d^^^^b(^y^"S36), #|^Rrig^Pi^^$>«9, ^o77^tbt 
V^*-^^«(^2/^S35, S36:Yes), |D©OR|®!07i3Vh3:y^*-eittfT7' 
n-^Sb^HtT-TS C*tV:/S37). — *\ ^■7 i ^^S35^T#|^Brtg^Pt^^ 
^V^^}C{^^^S3lcD^S(cM^>^^7 e S36lC-CT^^IJ]f^^5tJbT 
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031, 033, 034}i, ^rtb-€tb#P^W]{WSl— 3CDMa^fe^-f7n— ^-y 
5fe-f , KkWt (step-l) (^1@®^»J •MI^-t?t?)^<^#I^II]-f^S^oV vtSfcBH 

z z 

z 

z 

(^^S42:Yes)«, ^~-^m¥(S)^mn ~tZ>(7STv7S43) Q 

f£(3) fis ^l/^-lf^a^^^^^^tbfc^^^h^lb^^U Mffl^SS^ 

^—^mnLrXW^m^mir^mxh^^—^mm2)fj:t^mtmU(D 

m¥®MX3bZ> 0 

*^ry^S35tmm. 1^— =^W)1¥(3)tfj&ZhVtlb (^^S44:Yes),# 
U ? ^y 1 ^7 P S41<^*aS^ , 9)Si-o l^^^tb&^o/c^ (^2/^S44 : No 

i"J:5^s ^#«J1 : '<Dn^Vh^g0^l21L/ / R«®i81^fe5^-r 

1 2 

n#VH£Ste, ^CO^(step-2)OE|®182^TO"e#rv^ 0 I® 
® 1 8 1 fcRSffi 1 8 2£<£> Pfl iz. {*^r <Dlib"9 ± tf t£Z «t *)*&rsf? 1 84 £ 
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1~3o #l*SbftKl)T?BU 5WE©S(step-0)©lSiei8l36>e)^C©a(step-l)©lifffi 

5-2 : (step-1) (Dgg® 182<Z>:*:#&flS+$H2::fc#V n 

i 

5-4:^^yv?BE d^J£jSl21L/R<^H5^*WSE^Ibackjc^^.^^- 

1 

*3tt5$U^^7^— ^backjcJimit«t«9^:#V > 
^-C, 3e^2feS(step-2)OfgB183SrfRW"e#*i^&^, Jfc©(step-i)tf>fig®18 

z2(DM (z2-zl) j&>£>* #C®! (step-1) <D&mi82ib»ty£<Dft.<D8L (step-2) <£>J2§® 18 
(step-2) (Di@®183^BI^-e#^V^#^-}*. 

^7-rAK]^^T-r§ 0 o^hgatt, m^^(ste P -o)<Di@®i8i^v^r, 

mMl8KD^y^^y^BB \Z.T=7^ VUTV ^ e Jgffil8l£KBl82fc©lffl 

0 

0=¥-V5/^184^#Vn#^^^, ifcgfc (step-1) <Dj@® 1820^t3^brc S /v?FE i ^ 

LT, JScO^-YABifplCT^ 2feCD^ (step-2) (D|@ffil8307n>h3iy^FE 
-fVU E§®183{z:MjU ^tfV^^i?BE CT^^o -ffcfc>*>, #l£kf , 

2 

y^^^oi^^BE{CT^Vi-§^?r^^AK]f^ti->5o 

^f-Y^184^/>$V>#^^«, m£tf>^ (step-0) <Z)j&ffi 18 \<D*y9=.-y 

0 1 
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O 1 

i 

i 

(step-D (Dmm^mm-c^m^mmir^t^^o mK.it2&mn^yhm 

step-0) ^*5(t^l@®^^^^(step-l)(D|@®^WJ-MI^-r5ii^-et-r> 2©3c 

(step-2) x«^ti,^±^c<^^ (step-m) (D^mm^mm^i^m^M-^W}^ 

3KloVvCt&l3J!-r5 0 5fef, 2^^fe<^^ (step-2) <Dl@®^m"5T^m^{- 

v? 3 ^i/^Ai^j:«5 2^©^ (step-2) <DiTO&^i-fgf&1-5 0 rot-flf^ 

(4)te, 2^5fe^>^ (step-2) CDl^S^mfii-^^, _hifi(D^^^S43^iftl^« 

i¥kmz>mt<Dmw7t\-±, inc<^(ste P -i)oi^ffio^^n iz.£<QmwT-rz>zk 

z 

&X%Z> 0 ^(step-l)(Dj@®i«, (step-0) (Dg|®J;<9BtraW^Sff^ 

-tUT, ^9^Atb^«^bf c ^(^ y ^S53:Yes) N ^^S51}CTf-— 
^b^m, 2^3fe<^^(step-2)^(±S$^-CV^tf Ux^7 P S54:Yes), ^rtt 
&toPgl££L-r;e$TL(step-l = step-2) (^^S56), ^X5/^°S51d^<7)M 
^^3li- 0 ^X^S51^f— ?-mm4) \Z.X2Wcfr<DWi (step-2) <«®#M&tU£ 
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ft&g-&mmtvxmm-rz>o 

mx&%&, wm^mt£nvWt%<D$k ( s te P -m) ^x(Dmm^WMm^:tvx\ 

b&X%% 0 irtefrlb, i# @ , S <£>B£®<D,fS£z-z ^-CfetUMIS^T?) 

i i— 1 

#(3) ic^v N-c^»ii-5{@ffi(D it ^^<o^xy)nfm^\zr^m\z.xmMm^ 

(Df—ZXhZe 

64), m+n>k-efctl/fdt(^^jy^S64:Yes), step-(k+l)~~step-(n+m)£r, step-1— 
step-(m+n-k)(n=m) bVX, 3£tfb(^^S66) . ^^Sei^O&La^ 

ZMftbm%mizbxmmir%Mffl^y*-?&^1r%<D&X\ mm^^b^ 

. myzzbi>mm<Dmmz.xmft-tz>z.btfx%z> 0 m^nmm^m-r^un 
x&z> 0 
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H35Alc^i-#ft!l«xW-^rix ^T^-To 

step_min_z : fl&<0gte&g:©©±<E>ilG&tf>IS («fc?)±tf ) <D%&*Sfflk'MSL 
step_max.z : m^E^t^S:©©^^*©!! (SW-Bf ) ©#ft«rtB**fl[ 
ad (align_distance) : T^^fitC^o^S^^^h^^FEici^yh^ai:^ WO 

SBtt 

ax (approach_x) : TZ?v~^&WZ&tf%7v^V^y¥FEbvy$vh^Wk<&ffi<£> 

mm 

frontjJimitrlgffiUl&ttS^nl'h^ 

(minimal x-value) 

backjJimit:]gffifc:i8tt3'W 
maximal x-value) 

back_x_desired:^^^^^^BEiMiSl21<DM^^^{Sil0^^e(desired 
value) 

jWiS*Vvt><DiU f^«9_hlf ^step_max_zj;<9^:#V^^^{4 % ^#^"5T^J»f 
-T5o H3=B*fc:, V&W&WO&f&Vtt, «tt> -htf # step jnax_z i <0±^ fcl fit , 

ttI^v^©iU ste P _min_zJ;<9^:#v>#-^^(i, WgfcX-M^F Tsr^JBffi-Sfc 

align_distancefit, T9-YV*I^S:i-S»^f-^*ftffl"t"5^" ? ^— ^"C*>9x P&IS* 
S^*H-«^l*»lf^*fT5^t-ffiffi$*l/5. PJ«te, approach_xt>, T^n-^tt 

front_xJimitJtU ? backjc.limitf* > o^h^gasggS&LTV^J&Bi:, P^hit© 

^kofft^/J^v^^Kifit, ^oj&®{^l!j-e#&v\ XKM£»-Ctfc£l/Ofe3fc 
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backjc_desiredte, 3^<^Jgffi^^tt5''^y^5'i ? BElCjttUTciaJ?s'bgflidST9 
35B}^-Ti5^> S5®^"Cfctt}^ back_x_desiredte, /<5/^m^BE«t«9 

®36&tfg|37kJ:, IH35^i-$!j^^— ^ffifflU-C^tCCi^V^g^# 
PgaSrS5»if^Sr^U-CV ^ e *_kgb&»&#-l§'IIRtc* ^xy^S310^— ^lMt(l) 

Hff (No. 1) , ^s^SSSOT^-lVIbft^fT (No. 2) , *tV:/S3 

2(D~9—?-W)i¥ (2) Hfrtf^B^ (No. 3) , ^ryZfS^KDTZfn— f-WjfcMffOU 
=f- (No. 4) , ^^S51 ^«jf^ (4) HfrOHB 1 (No. 5) , *?ri?zfS52<D9 

^AK)f^(2)^fi 1 <O^T-(No. 6), ^^jy^S520^'fA«jf^(2)^#-efeo-C 

^Ujf^(4)H=ff^#T-(No. 8), •••Sr^U ^fbfi* (4) «rUT»ca©iafiB*MB 

ay$ti/^^ofc#-^(No. 17) (c % pg^#i#»^T '(7-f=is^'a)g^|f^srffo-cv^ 

-5^^-(No. 18) 3r^-r«, 

037te, ^^SHjf^^^O-efe?), EI36<D^lbf^irl^#^, "if— ^tb^(No 
. l,No. 4, No. 7, No. 10, No. 13, No. 16) , (T7-lVf!jfNs tiO 

<HftD5KL(No. 5, No. 6, No. 8, No. 9, No. 11, No. 12, No. 14, No. 15), 
Ik^'Dm^mM^tl^K^tc^X^^y^m^n'oXiNo. 18). 
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1-&i><DXh% 0 

B<7)J£Jg<D|ll#£^i-ElT*fe3 0 El38^4oV^, 191^i-<D}*, ^®(z=0)^b 

TlR'J ^*D{tS3^»]ffiCD^^^ z o = 0, mm Jb{B!l Kl*5l*5^tbffi <Dm£ i>H2= OXh 
5i^fcot, ^£zO<^Sjffi£#»jUTV ^Lfc*§-g\ zl-z0=30>0 

-C^(©-e^(Drai91— <^^tt)tt^«9t(]^fJifU z2-zl=-30<Cn?fc5 

<^^m9i*^^^^^<D^i!]«i^06tb^fcs^j^-rs^t^-T?#5o - 

ront_xJimit^t^ackjcJimitfi N fpJH%^OiiS"efeo-C. Gf#VhS^£>,S:l£l21/$S|2l 

38 td^1-£5 l£|flS 1 9 lfabn&mvtitkMXh'oXh&W} *imkmWrirZ>Zb$: 

mzL. <d&&(ww \zwozwflF\&\ ^xmm-tZo 039^ ^--(Dmnt 

v7$yy&W:<7)%Ll&<£>m& : £^irmxfoZ>o m39tc*5V^T, i92X^ir(D^ 

z = 0);5^ft£^zl=-30^fc£|M]^£;^U rr-m, ntf;VH£g«I£(stepl 
)t^6Dfl^l92<D^®T#J75^±{|iJ^#tt)«#^i-oV^ia0^-r ; 5o [M192 

z2=0X&Z>Wi&XhoX, M£zO<V&Wjm$:&W)L'X\<^bVtcWfG'. zl-z 
0=-30<OXfo%<DX7&&(DW&192^<D&mte&V%m^km%TU z2-zl = 3 

o>o^so^in]^i92d^^fs^<^#Kf»5tti^^5^JiT-r^^^ 

-e#5 0 ut^o-t, $kui9itmm, z.<Dmmz}fc^x?74^mmzio^x, ±& 



* 
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o 
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^tVX(D^ J rV'^r\f^3ly^^J^ (Stereo Vision System) It. 3fc7C<D%3M s f'—? 



^§sfP2b^ffi^-r^o 

m<D^t&(i&i&M:seed region) f^LT, ^m^Mtn—^-UKMiT^W^M^ 

m^x^K^txnm^x^<mmmmKx^xmmm^mm^m^mu 
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m-tz> 0 yisjf-i*/**— ispT£j&f$\^xmmmiML%WLnx%z>h<Dxfoti\s , 

$oi-f%&±m&1rZ> 0 m&fa<DfflZ-ltftj3fa<Dm^\ (image row:-f^— v 5 ^) Kid 



» 
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£f\ ¥-m<Dmkt£Z>mmUT \ m^Uiseed region) £V^o )£31H^ ^fS^ 

^mmm^m^^-^m^m—w-m<Dm^w^^<^^xm^Mvn 

over-segmentationXi'iunder-segmentation^^f't>COPo^M^ 5 ^U-"CL^5o -%:ZLX^ ^ 
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o Bftt&ltiMLme Extraction)2ate, _hi&LfcJ;5^ 7f 

l^cfc^ JiaTRb^lover-segmentation-^under-segmentationOPp^S^ "t"^^^>s ^^fefi 

^^^SiL-C^i^b-Cb^ofc^i-^Pp^M^lElM-r^c^, 7*' & M-tOft 
^^^CTii^Wi-^^^-l'^^^^-frST/^yXA (Adaptive Line Fitting) 
^A-T-So Adaptive Line Fitting^ i^ttttJ^a^&V^C. :fei*J«#J7<:#V ^ 

if ^ (zig-zag-shape) ^mx^^m^a^ &m\zm , o&foz>tL,x7*—?&m 
ML,xm^m^B^<Dmm^noT/^v^^m^^<Dt-r?> 0 

IH44(i, ^^mif|32atC*5{t5MS, i"^^^. im3K*5tf5*7^yXS72<DM ! 
^P(P[0---n-l])^bTtttUi-5(^7 i ^XS81)« > ^UT, ^©f-^^#P[0 



• • • 
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n-1] [Z^tVb^Zf/lsWCnifi&mzMm&i&mte^^Wc (&3?*/JHtt) min_n 

V^^(S82:YES) Wi, *ftffl»*ibT5fi*'frS:W^7U-C«!!a*»T-f-*o 

[0 • • • n-1] ©— #©«M£P[0] Hkfr<0Sk£P [n-1] ££r^H# (55) Ll*»l<Oj» 
^ibT^i-5o 9*— *jGC#P[0' • -n-l]^b. Z.(DMftLlb<Dmi£ftm> 

-^^Pf- ^S¥P[0- • -n-l]^S ^(^#J^)brk^T2o(Dy ; -^S¥p[0- • 

•brk]^OT[brk- • -n-lDtJl^-SRl-f 5 C^^y^S88) . 
— ft^Sg»st^^-^^^#J<D||{ii:max_(lJ:«9/jN$V>^^{i (S84 :NO 

) % <?—?M.ffi>lO- • •n-l]/5^moZ&i-5ft/h~^^^j;o-Cft®^^(D^^: 
line&3££> (^2/^S85) , ^(D^U^\\ne^irW^2^m2<Dm^t\^X^ir 
5 C ^LT, X-^^P[0- • •n-l]^-<DM^L2^>^U-rm^-r ; 5Zig-Zag-Shape 
-Cfc***if5d^W^5 (^5/7°S86) „ Zfe-Zag-Shape-Cfcl (S86 :NO) x # 

£fc, ^X5/^°S86^*5V ^r^7 i ^^ e S85-T?^fe7^^^^Zig-Zag-Shape-efc5 ^ f ^ lJ 
^nfc#^ (S86: YES), ±&<DXTv7'S84b\»\U, ^^7°S88^ii^-, W 

[0- • - brk^T/PCbrk- • -n-\~\\Z.<ft'mirZ> 0 Z.<D*^y^S88KX2^(D?—?MM& 
fcfc, ^X^^S83 -^^C#P [0 • • •n-l]<Diffi&Zffi&mfrLl&$LJ$,'t%h 
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^-T5/^S85^*5tt5ft/J^— (Least-Squares Line 
Fitting) KOV vtffc0J!i-5 o fcSn^^r— ^^S¥P[0- • -n-l]^^it, 

fB3£(i)-e^i- 0 
Hfci] 



*cosa' + ysin^ + d = 0 



(1) 



:©f^, njS<D^— ^,&pP[0- • •n-l]©l^(x,y) teJSVvC Wfcft 

i i 



[«fc2] 



£ ^ = X (*j cos a + }>i sin a + rf) 2 



(2) 



Bfc3] 



1 -i -2^ 



a = — tan 

2 5 2 -S 2 

- 1 v 



, rf = -(xcosa+^sino-) 



- 1 v 

n t 



(3) 
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XTy7'S86lZ.*oft5iWJ ! yM (Zig-Zag-Shape) WJ^Sr^OV >Tt&931- 
3 C £<DZig-Zag-ShapeTOJ-Ctt\ fc^nfiOf-^^SPtO' • -n-l]£E$lLine( a , 
d) „ xcos a +ycos a + d=oaS-£*.b*lfc££\ ^(Of—^MMPlO- • -n-l]^ 04 

Sfc**^— *^i¥P[i]&#$I^S&KtfSfc5o gj 46 Zig-Zag-ShapeflJSiJ^^ 
a fit, ^Jo«SHfi8MSr^i-o iOSMHa ^^OHjfith.a <fc 

ttltC&5*^sing(sdist(P[0]))lU:o-C^»fU -cD^Srval f^ftAi-^t^t-val £ 

0 0 

S92) 0 r^-e, sign(x)B\ x<^1il[<^^F#( + XH:-)*iS-t - li*rCfe«J, sdist(i)J2x PCfl 
.xcos a + P[i].ycos a +d£LTf^£frfcEMLinei;::2oV vC, i#= 0 ©t* — ^^i:<DjE 
&<Dffl&&7F** f^fc>*>, Val ^-^^P[0]^ji:^Line<^^^^IiJ^fe^^^ 

0 

Of-^(WT, JcD^-^^T^^-^PM^iIlIIw^^^^ 
&5d>£sing(sdist(P[i]))tC J;o-C*IWU wOltm^rvalt^ft Ai"5 (XTy7S95) „ 
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0 0 

^dW^*^(^X^S96:NO), val (Cval^ftAU ^M&XV^M^hm 

o 

(^s/:/S100);*7^:/S94;6>b^S^M5o 

— ^\ ;*7^y:/S96{;i:kV^ val £val£#^C#^-(^7^y:^S96: YES) x 7 s — 

o 

hfficount^Zig-Zag-Shapei^J^^^fc^(75^/jNO^— ^^fcin_cj:l9^:#V^^^ 
^^J^b(^^S99) x ;*C#l^-Si£« C*7^:/S99 : YES) , Zig-Zag-Shapei 

^ft/hCD^— ^^fcin_cJ;?)/J^$V^#^}C^(^^^S99:NO) . ^y^SlOO 
Icit^-, 7 s — #&%$^#(D%?>'h{m : &4>'?})*>hL.X (^.X^SIOO) , ^-x^ 

Wcnizm^ir^xmn, ^^him>=nb^otcb^x\ falser mtsvxmtm 

^<D£?tei?y*F?Km%mm\Z£^X^ niCr-^SPCO- -n-l]£lij§&Line( 
a ,d) :xcos a +ycos a + d=0^^hthtlb^, ^(D'f—p&ffii&m.T&LmelZtt 
^Xzig-zagiZ&m\^X\s^fabofa&WM-fZ>Z.btfX%Z> 0 ^tlKXoX, _hx&Lfc 

M:'h~mfc£V)%:i&tz:WMizttU "r—^^m^zig-zag^mvx^^bmWr^tc 

m&ia*ir-?&m&ftmir^bmmvxxTy^s88<D&m^m^ m @ & 

brk*ftm&b\^X^—#MM&ft^\-tZ>^b&X%Z> 0 >fc^o, if^T^/Sgi-;* 
rO^ftZig-Zag-ShapeWj&iJSte, i^3&<^&ib-fv^— K^T^^t? 

-^^TBgT?fcSo ni48«, zig-zag-shapemmm%ft?mm^&^-f^y?m 

XhZ> c 048{C^-rj;5^x Zig-Zag-ShapeWJ^Sg^Ofi, nfg^T 5 — ^^P[0 
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-^^P[i-l]l-*5^^I^WJ^mVal b%it%ff%t£mi$23b, ttjm&23K& 

0 

V^Val=Val <DW>&\^ ^^VMfi^^y^^bi~Sit^^^^24t, 

o 

#?^24<Z>#!>>"MIcount£S/J^^k^ 

^mm_ck^it^lir^ttm^25k^ir^ a 

Jtg?§P23}4, ^-^^P[i]^^-^^P[i-l]cD_bfBIEA^^ltfeb, 
^T*fcS^iC^[>>'^24cD^^>'Mitcount^>'^i;^^hi-^{f^f±l^U, IE 

^^^Mtcountift/jN^— ^^toin_c^^rittfeb, ft/J^— ^mmin.cJ^^h 
fttcount/^A^V^-gia*, ^&i¥P[0- • -n-ll^^if^-C^ri^i-ff 

JfclC El40^^i-|S^it5M$|3 (Region Growing) 2b^oV^tft^i-5o Wci£3S 
£B2bte, ^ttm$l32a^J;o-C#^fc^S¥^A^i:b. ^h^lSWHrfveh, 
^^(D^ffi^C®U-CV^5^^^lJ^D¥ffi^^^-C^ii6 (Plane Fitting) \Z£<0¥mV, 

^hfvbm^m^^mm^mm^m {^mmm \^m-r^ 0 mgcv^mz 

(DXh^O, ^<D3^(DW^^^fh^i^^W$M(seeA region) iV^o ^rUT, Z.<D 
5pffi^(D^r«i6 (Plane Fitting) K^mWrU m^-T^U^tm^m^^^ 

bmm^tc^\zn^<Dm^n^^m(Dm^bvxm^im^mavx't(D 
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o 

Z:MtVf— ^^J33Xfi34^^oV>T, TOPtl^— <D5p®-CfcS^^M^-f5 0 

&m%mnirzb\<^£?te&hm$:m<o?&u mmmb^3^(Dm^^<^-^x 

m43<DXTvy°s3<Dm ! m&Wi , 9Mir 0 

Fitting) , Z.fo%&m\^XW&W&W j 8i'Tttfe (Selection of seed region), 
frh^^%fo^X\<U^lttfe®M (Region growing) % &m#<btLfc¥a£;^5£ 
^^PM^^:#V^t>CO^if^^V^-CM#ai-rS^^^ ; a(Post processing) MoV^T 

3&55£P^I*|(7X£PJiP=(x, y, z)UU;<9*£*K 5pffi(D^@^:f^O»-<^h 

i i i 

/Wi(nx, ny, nz) £#^^d^J:oTTsE5£(4)X^£;h,3o 



xn x + yn y +zn z +d = 0 --(4) 
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Mn,rf) = £(pfn + d) 2 - ...(5) 

I 

&MMt£n=m/ ' m ■ , d=-l/ ■ m ■ £L-T3ft*5o --~C\ " • " tt, ^Ph/W^Ss 
mW\ fT^^^io-Cig5t— ^m^Al<^^— ^^)&I'J (Cramer's rule)£H£ 

me] 

A m = b ...(6_2) 

A = £PiPf» b=£ p< —(6-2) 

ott), _L!E5£(6-2) te^Afcb©te<SrM*rf-<5©2*-C. *Sr??tH|t 

©2o©^yKl^-^yh : : #ffc) E (p) , E (pp )*sgE*n 

T 

xm, Zfrtb&tiZmVX, TIB (7) ^l-J^CA, bSrHSffi-5^.^^-e#> nliO^ 
- * ft5 ¥® *Kffifcifc9W Z>Z.btfX%Z 0 

GBfcT] 



A«-A + n£(pp T ) , b<-b + n£(p) ... m 

— ^^©spffi^S^d^O^tta^V >^-T 2 l z ®^^^>2m¥^^M (RMS 
(root mean square) residual) (£lTs rms£V^„ )&TK^(8)lEj:0J!Effli"5£to& s 

[#8] 
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nwOPi-p B )- J^LipJn + df > therms ...(g) 

_hlB(8) ^i-«t5^, &^—*j&ft&iblz¥-m±K&M¥mXU^e>2m¥ 
^lirms( P ---p ){io^5{^^^fc | 9,r(D^i:^/J^$v^^^if#7 :i — 

1 n 

IBMi )t*>ot, 2v><d^(i , i ), (i , i )K:*5rt5®*(ifc«3» J ±e9**- 

1 2 3 1 2 2 3 

Pf#F fc 3^*5tt5®^'fif:» ; Sr^i-^^^ (index) $yfiO/C*3?). ^ilx^fr^lR]© 

12 3 

^y:/S103) o ^UT, ^¥®^@^2mTOil^rms(l ,1,1 )^jiiflcm 

12 3 

rms 

rms 

1 4 

*S^Lfe»^(^y^S106:YES), ; t05pffi^SS:<?52MI¥*&8ftllnns(l )£ 

4 
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rms 

•-a^te^z®/"^— ^^rJ€ffb(^5/^°S108) „ f?T#*^:/S105/&>kO&! ! 3g& 
^r-C, ^»!j^*5VNr«, £gi^l£$iSiU 3o(D^^p— 

Km-fz>fa&fr(D¥ma^ _tis^:(8) zmm-rzo -r^-h. ^m^m^(D2m 

^m^mmrmstmtezM&^-fm^mxfrZo ^x% ^nxm^x^z, 
mmm%mirz>m. & s <z>Mi <d&m. (end point) ^sp^EsttD© 

mmTrix^^xo^^b(m5iB)b^mm^mp(D^m^m^ti^bb^ 

So ^-C, ¥ffi;^@^02^¥ : i£j^^rms2rJ&#><5^ |2|51A(Diij^La^£>;fc£5 
5£&jjU£:(D2%:^i%m^rms (La) lCit:b-rlll51B(Oii:||Lb*^^*5¥ 
^<D2m¥^Mrms(Lb)(D^-^^:^VN 0 El51A©£5^ iiJ|Lat¥ 



♦ 



♦ 
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o 

£fc, ±5z&<^^$«<OiiltR*-?S:i^ @52(D<i:5^t*^i- ; 5-i:^ _ e#^o overlapO 

j k j k 

fitPlaned , 1 , 1 )H\ ±|E^(4)- (7) ^i<9Am=b<D^?^*¥ffi^^— ^n, d£ 

1 2 3 

n-stu -hisses) \^nm^ntcA, bKx^o. bji^ivm , 1 , 1 z^mzy^y 

12 3 

1 2 3 

m¥-i%mg:rms<DiW.%W-lil1~Z>^WtX*&Z)o *fc, removed , l , l )Wu linesCi], lines 

12 3 

[i+i]i 2 , iinesii+2^>hm^n^m^^tvxm^rLtc^ri : efhmM\, \, 

bte, ±lE^(6-l)(C^i-^^ti- : fT^JS:0 ? -<^h/V-efo5^ *fc, add(A, b, Dte, 
±fB^:(8) {CfctK Aib^iijiUinetf)^— ^h%D\\7tZ>mW.XlhZ>o Solve(A, b)(*. 
Am=b^fc-rm^fc, ±WB^(4)-(7)^<J;(9TO^^— ?n, d^ff^So 
select(open)te, #J£tfft3JJ<Dlo&£\ open^^^lcl-loO^Wi/r-SrSliF?. 

|&-T?&5 0 neighboKindex)f4, ^x.^nfc-TV^V^^^bfc^'^-rV^^ 
#»Jx.fc£{index-l, index+D^jg^-M^feSo 

^ttli-5^a(Post processing) *fto 0 Z.<DftmW-m-fZ>tQtMXi^ Mx.lt±.&<D 
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^fc^^CD^tDggil^—^^ (pixels) ^*5V^T, 5l£JSSLTl^5¥ffi<W%, P 

&m&&Tzut&(Dmm&&-t-&gffl. id54b«, ratt&x. mM&y. 
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tc, ttli^MfcSCfc 5 ! 2 ) (correct extraction(horizontal)) te\ trjjfaOy*— ^\%\^ 

^Hi<D^^(mW.) (correct extraction(vertical)) te, fUJifaV'f— ^\\UK^>\^X 
(DmtH(D^^i- 0 *fc. No. 1— No. 5te. ±5zgbfeZig-Zag-Shape^lJSiJMS^ 

^9Anrv>^v^t^*o^fe?g^^«t?)5pffi^m^a«5o^#, no. 6«\ 

Zig-Zag-Shape*IJSIJ^^fTofc«^FJ^^tt5^®^m^)fe^^#^i- 0 

(Line Fitting) fc&\,^Xmfe<Dtc£><Dmi&< : 7*— #max_d&±%<1rZ> ( 
max_d=25, 30) t^tii^T tfV, IMmax_d/h£<i-;5(niax_d= 10, 15)y&tW 
^[^±-r5 0 ^ft^LT, ^PJcDi?^ ^iF^^liEMa^Ai-SiiiC,}; 
0, ±#ftlliffimax_d=303rt3:^L.-Ob. mfotd&\ti1fe%&7F-tZ.b&t>frZ> 0 

tiX\^z.bftt>frZ> 0 

<Dm^h±x(Dm i m^mt\.xmiiix^x\^o mi2B-m, » 
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[i] i. &wimmz£Q&Wi^m%*tfybmmz&^x, 

[3] 3. ±.m&m^mtvxmn%mx-. ^(Dmrn^x^m^mxh^ 

5JfciB#*:;|ftttJLfc»g\ ^ttJgBi¥^ti*t>^tP— ©BSDB^'fc«J;5iie^'t-« 

[6] 6. ±&m&mm¥8t&. ±m^mnmKm^mw<D^£Rxf&mMtmm% 
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[10] 10. _h|E#^^f*#fi, ±iE7D^h3iy^^^5/^^^{^^ti,fc^^-r 

[12] i2. _LfEisgj£i&m#i8:te, ±ia¥®tf m^m^w-m^m^-^mvx^m^ 

rt^#@:i:i-5t»^^^ffl^l^fB*CDn#VhgSo 

ci3] i3. ±ie#^^«, ±m¥mmmzm^&M£tifc¥m(Dmm^mirz>£ 3 £ 
tic i4. ±.m&nm-£. ±m¥mmmzm^mm£nt^m<Dmmzftmi-%&£ 
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[18] 18. ±IEPgjt£#MJ^#Ji£te> m&&W)^<D&mmz&tfZ>^y?^yi>i)mM 

[19] i9. ±.wm^nmm^mt. mz&mttMttezmm&tfimu ^tmwi^t 

^t^mmt-r^m^^.mmsm^m.(Dv2^yhmm:o 
[20] 20. ±fEiea#i$fMiw#©w:* mtfcm^mz&mtt^btezikmxteykmi^ 

^t&¥?mtttm?k<D^mmi9m^(Dv^yhmw:o 

[21] 21. ±|E^#l^$iJ^#^}4s^»^ttffi^^^/^^^^^Mi^U7t^ 

^t^mt-r^m^mmmsmm^u^yhmmo 

[22] 22. ±fEPgl£#»J^4m> !@®{c:^-r§-hfB#«]#moOT^^b7!i/^7 
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[23] 23. _hf5/N°^-^«, ±mm^(0^±if n&X.\-t&TlfM£lZ.m-3%&:fe£thZ> 
[25] 25. ±|B^®^m#^«, 3^5c^rfl-ei?l-2f®-ht^5i:*i^$^mil-X-^ 

[26] 26. ±mm^mta^m^ ^mmm^-^^r^mm^m^m-^m^^^ 

^b%wmbttn&<Dm.fflM25mmm<Dv^yhmw: 0 
[27] 27. ±isi£#*4ttt#im, ±mm-¥ L m±iz&%tmfe£th%mMT-i?Mmfrb 

-^^#m^-r5it^^fBia^25^fE«on^vhCTo 

[28] 28. ±!El£#*4m#lS:te. iiEl^-^ffii^fc^^^tL^ra^-^^^^ 
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[29] 29. ±tB¥®i^i?tii, m — <D¥mzm-tzbmi£isfrz>m±<DMft%% 
[30] 30. ±m^ffim^mmT%&MT-?&miz&\,^x. ^n^mm^mtcD^m 



[31] 3i. ±m^mmmtt;^&fe,mfr^£vfctL%¥mk±mmm^mt<nmm\< 



[32] 32. ^m^m^x^m^mti^yhmm(DWii¥mn^mz^^x, 



[33] 33. ±IE3^(DEggi^-^^#i-5gg^ltfSiJXm^*i-5 

[34] 34. _hte^sj^im, mfcm&x$>z> 

[35] 35. ±IB^^Xa«, 
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36. iiewatftmxm-cw:, iis^Eif mzm^mmcDjzgzzLXfQmwm 



37. ±K»a«»Xi&-Ctt, ±IE¥DfiW«^^#BSffi<o^#$&TJ^M6<j^ 



39 . _t r5 



: 0 



41. ±SB»a##fl!l#PXS-e»4, &&fflh*<DfflmK&ft&*y9=zv*Si> 
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[42] 42. ±R»a#»«HIP3jB-CW:, ^tWi^iffi^tHU ^JKBgffifc: 
[43] 43. ±!5^#I^^X@Ti*,m^g^^^:{^»^i:^ ; S^^X«^ 

[44] 44. _hfE^#M^IX@-e«, ^(D^tbffii^tt^^^^^^^^llt^cBff 

mm~tz> 

[45] 45. lh|Emi£#M#PXf£-m, J^B^^J-r^^tb^^CD^B^S-r^C*© 

[46] 46. teK£S3Ibfls£|$t>5Sb«^±fE/-«7*— ^©M^gt5^7^- ^§3 
^^#^ti-Sft^O$5Hm45^|E^On^h^g©Ilj^$iJ#^fe 0 

[47] 47. ^ib#s^t)^«jRrtg^»i^a^v>-c, 



1/56 

WO 2005/087452 PCT/JP2005/004838 

[Hi] 



o , • : Node 

: Line 

• ; Shape feature point 

527 




501 



FIG.1 
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[02] 




602 



601 



FIG.2 
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[H3] 
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FIG.3A 
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FIG.3B 
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FIG.4 
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FIG.6 
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Close gaps : 




for each triple of consecutive points do 






if distance first to last point < </ gap then 






remove middle point 






end 






until no more changes 




Fit line segments : 




for each triple of consecutive points do 






compute least-squares line fit with error 






end 






for each fitted line, sorted by error do 






if error < e flt then 






remove middle point 






update first and last point 






re-compute fitted lines for points 






preceding and following line 






end 






until no more changes 
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Input: pts : vector of points, n : number of points, ot,d, <7 : parameters and std-dev of fitted line. 
Output : true if curve contains a zig-zag- shape, false otherwise. 
Sequence : 

if a > thresh a then 

valO =pts[Q}.x* cos a + pts [0].y+ sin a+rf 
count = 1 
for i- 1 to (n-1) do 



val =pts[i].x* cos ct+ pts [i].y* sin <x+d 
\f{val*valO <=0)then 

vaJO = vs7 

coz/nf = 1 

else 

couaf = count + 1 

if (count >= min-points-for-zig-zag-shape ) then 
return true 



endif 



endif 



endfor 



endif 



return false 
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Algorithm FindSeedRegion 

Input: JinesfiJ: vector of lines for esch image row (or column) /, 

n : number of image rows (or columns) 
Output : set of lines (seed region) or empty set (no seed found). 
Sequence : 
for i = 0 to (n-3)do 

for J } in lines fij do 

for 1 2 in lines[i+l] do 

for 1 3 in lines[i+2] do 

if overlap(lj , 1 2 ) and overlap(] 2 , 1 3 ) then 
fa d) = fitPlan e(l ) ,1 2 J S ) 
if rms(]j J 2 ,l s )< thresh 1^ then 
seed={l l9 l 2 ,l 3 } 
removeOj ,1 2 ,1 3 ) 
return seed 
endif 

endif 
endfor 
endfor 
endfor 

endfor 
return {} 
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[053] 



Algorithm RegionGrowing 

Input: region : set of lines as seed region, 

linesfij : vector of Lines for esch image row (or column) i 

n : number of image rows (or columns) 
Sequence : 

A=0 y b=0 

for 1 in region do (A,b) = add(A y b,l) endfor 
(n,d) = solve(A,b) 
open — region 
while not ernpty(open) do 

/ ; = sehct(open),open = open - 
for / in neighbor(index(l j )) do 
for 1 2 in lines[i] do 

if overlapCJj ,1 2 ) and rms(l 2 ) <thresh2 JWS then 
region = region + {1 2 }, 
(A,b) =add(A,b,l 2 ), (n,d) = solve(A,b) 
open = open + {1 2 J, 
remove(l 2 ) 
endif 



endfor 



endfor 

endfor 

plane = {n,d,A,b,region} 
planes = planes + {plane} 
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